float32 odom_hz
int16 odom_color
float32 odom_x
float32 odom_y
float32 odom_z
float32 odom_hdg

float32 cmd_x
float32 cmd_y
float32 cmd_z
float32 cmd_hdg
